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(57) imm] 

b T ^Vi- ^ if ?r & tti il £ ^ S * — * y ^ ^ 3 ^ ^ *5 v ' 




Wl, W2 — :^'Jf htt 




[flt#«l] y bR« 

m ^frftji y ^>^-^\^^x, 
tufBis^^y ^ b«^>^y * h<o*w«s9©np 

[H*g3] tuffi^y 3> fcD*I^T^^*t±iLfcr 

(rll) 2 - (rl2) 2 - (r21) 2 - ( r 22) 2 
fc*:U rll, rl2 % r21, r 22- tt* V V h<D^Mt 

[00 0 1] 

tft^ ^fbi-pb<^^y v bRfc a^y^b* 
t^^^^^y 3> v<oWk%x/<^^^^^ 

[0 0 0 2] 

(SS^y y b«-r?fc£. ti. t2, -tt«sbv^PH<ob^ 

si, s2, s3, s4»*V^nt>^y ^ bP3ffi3Ji^K 

rtbtiizxy v ^^ sii,si2,si3,si4 rais^y ^ bttt 

6 o ^K|«<z>b9s'^tl, t2, -Ji^BBPbfc^y 3> b 
sl-s4^. a?l>Mffiwl, w2-fcU#jS&*T>£o 41, 42, 4 
3, 44tt»**?\ 51, 52, 53, 54ttg**^-e*>S« 

[0003] isitev'-r ^ b 2 ^iHite-r s h ^ y ^ b R 
« 3 frmzr %o ^*^^i-44i: <9 <d%yz* y ^ b R 

« 3 i^Rtt bfrtc* V iyh sl~s4, y s> b 4R 4 I- 

RWfett^^y s> bSll -sl4 Sr3ffi9, 5**^51-54 
KigftSfrSo S3te**tfc*»4S**^5l-54t2iJ:!9« 
«E^K»S*vfca, SJtelUKSP (H^^rf) fc<fc0«ffi 

^«^tl6o rcomffi^^ffiHI^. Hi 7 CD (a) , (b) 
frfclfcffifllSr. 0 6(a) , (b) t^^o 

[0 0 0 4] **5^ 0 5t^v>T, i^-b^s^-t*-* 




(2) #B¥9- 1 2 6 8 1 4 

2 

y h^lofe^M^LTV^^ H4t^-TJ:5i- 

r^»^^K*»/S3teaifltrlB**«>^y y H 

S#SWJ^\ «fC^^y^b^r 

@^^y y b«4±^Ktt^fc^y bsli ( i -1 
-4) \z.X, «»<^^y ?/ bSrSiab/c:*^rtloco 

y o, bsli ©ffitt, si ( i =1 -4 ) ©(StSl^fl- 
10 ftbfrX^&o 

[0005] sr, %te<Dv—9})^>^—?<o*yy 

b«3tt:, _bffi<E>J:5l-*y s> bsl— s4dspD*gwl, w2 
sl-s4^l^-^4 1 ^ J: 9 ^rici~S ^ s ^ P BSA1, 

A2, - (#*»»#:«#*) *S«ll'£?03&^HBT,SS^:# 
<ft9Al>A2>»-i^5Blfffcfc3o ffM>0 

t^v^y s/ bs4«:aia-rs3fc^t*St^i-, s^*^54 
20 raHd s fcofe 0 

[0 0 0 6] 8**^-41, 42, 43<DgM^tr^ 

y^bsl, s2, s3i^ii^^^^^t-. MiiiWi^ 
12 0° -e^a.—^it^s o%coS^^tL^/^^dti 

*jBt^ s H6(^(a) i^^tltV^ 0 07(a) fit 
ft^Sl 8 0° -^7*3.— 7^>f Jt5 0%O/^^«?KH(fW 
^^-Sr^Sftd^^y 3/ bJ:!?*^^^^^^^ 
"C. X, tt'MM<E>;*y ^ b ( J: , 9^C^^^^-■ov^T^ 

30 ^<z>*y ^ hi3Tii ^y y bn«3<z>«i^jSvNS 

MPffi5Bl^ft< ftS<^"e^ ^ y ^ b«rSiabfe**^ s 
V^«l^ffl«^J5SbfcttI*«*^H7 (b) (DjRIftc-e^'t" 
fi»Jx.f*H6 (b) <D£ r^tfc^5 0%(^m 

[0007] ^f^. as^^i^r^yy^-b^^ 

n^-yojS^iat?. ii¥5-7 8 0 4 0fMtaat 
40 (OHl^StbTV^So i8»^, 1 
attft, 4fivyXt £,u^X2i:£itt^y^Ky^ 

b«, 5a-5ettlS^yi/h, 6aHff, 7 
fe-5o DfiHS^y ^ b5 a-5 e^b93/^<S"e*> 
[0 0 0 8] @^^y 3^ b 5 a -5 e©F7^to 

y ^ b«5 ^Ba*s^s*^**^^/s^ 

50 T^&££9^ftoTV^o ^tT, f^iS^y^ 



(3) 



1 2 6 8 1 4 



b 5 c ©*IdS/hS < . y 3> b 5 a , 5 e(D 

& x * 6 £ -bf b<z>4*« f Bit £ *t x v ^ o 

[0 0 0 9] b^b&/^, r^fl¥5~7 8 0 4 0 
b5a, 5 e <£ti<Z>K^B£* y ^ bffi 5 £*b 

£;KTV^v^c^#i\, X, 9 iE b < 

£3S»ibl\, 

[0 0 10] U:^ot, ^ito^>^«£ffll^T^ 
^tiS^^rTll^^y 3/ b 5 a, 5 e b&tftb 

mfe^v v b«5&^fc#*wibTH< 

y^KS<D|^ys'h5a, 5 e £it^b#OTU£& 

a\ ^^co^ft^i-^Fji^^^y ^ b<6<z>B5£* 

[0011] ±M<D X 0 * 2 0<Z)8&*<£> 13 — 

[0 0 12] 

bSMLfc^^r^y * bH«a£tfi-ll5£*y * b«i-7£ 
j$£;h,fc;*y s> b&SiBi^T, pS* y y b<£>3iB3te£r 

[0 0 13] ££>$£Wf*. KftSf^bKttbfc 

Tfe^r^y y hH«3fe^ll^y ^ b«t^J#£*i>*:* 
Al= (01 /2) [ (r 11) 2 - 
A2= (62 / 2) C (r21) 2 - 
fct£Ls, 0 1, 0 2 : ^y s> bsl, s2©^'C>:ft" -radian 
r 11, r 12 : ^ y ^ b sKD^MlO £ F*3flO<Z>¥^ 
r 21, r 22 : * y 3> h s2C0^«J t ftt'J^^ 

[0 0 17] p— <^^/^(BS:KPofB-g-ti % mi^ 

<£>#P<. ^y s> hSrSiSbfc**(^J:!9«^i"So ^y 
3/ bco®ffit;i£ ymM1r&ff3LA&&{k1rZ>k^ If-^ 



* y 3> bSrigiSS^-C. S^y s> b^Sia^SrS^te^T? 

H P MS £i£>- i-7FM bfcn-^y^v^^ y SrWfiE b 
fc%^"efcSo * y v bo*I£T^fb*ftb 

(rll) 2 - (rl2) 2 = (r21) 2 - ( r 22) 
[0 0 14] 

10 |IJK?gffii. SAT. r.<^*K^Jfi^ffi«:. 0BS:fflv> 
ri^p^-r^o Hi ^r^p^co^^Si^^gp^xy ^ 

b, 3^y^bn«-efcSo ti, t2, "-te^y^bR 

ffiS^figSttfch^S/^. si, s2, s3, s4f*;*ys> 
K Al, A2, A3, A4 (&jKSlS£ : ««F*) V V ^ s 

1, s2, s3, s4<Z>BBRffi«, wl, w2, W3, W4^]Jyhs 
1, s2, s3, s40ffi (=b7S^tl, t3, t5, t7<D 

20 [0 0 15] ^P^^^^-r^i^ ^y ^ bs 
1, s2, s3, s4 f^I^— <0^^>^*I^)fS ^r%m?£ofc&BX 
attZfz&\z.«tl1rtotix^&i><ok1rZ>o L-f^o 

^y^bsl— s4tt\ h7y^tl, t3, -«otPl 

-<©*^ 0 -emtfL&tix^&o hv^PtU t2, 
^rafiBT?, ^y ^ bR^ScoRSEi-W^O^cp^i- 

^by^^tl, t3, t5, t7±:^, y 3' bsl— s4 

^BHP**T/"CV^S 0 ^^PSOb^^^tl, t3, t5, t 
7, (CUP Lfc^y ^ bsl— s4^. Rjfc5tlwl,w2 
30 ^oTW&^^^^^^Rffi^AH » A12 » A13 > A1 

^^r— -efc£<7>~t% y ^ bcopp®WAi ( 

A2, A3, A4tt»b<*5o 41, 42, 43, 44»i«3te*^. 
51, 52, 53, bm^m^X\ rtbb«#^y y bsl~ 

s4(i*Hpib"CiaastbTv^s (H3#rsj 0 

[0 0 16] ^^ifiScft 0 4 n—* y^ 

LtRi*«Kt5o ^y ^ bsi*3J:t^s2oBwitw2<z> 

- (rl2) 2 ] -d) 

- (r22) 2 ] -(2) 

^•«:B6ih^tSo ^y ^ b<7>ffi«d5p]C-eS>S^i 
Mt^ir(l) i(2) Stm^ei =02 ^y^bsi 
^ J; t^s2^«wl ^ w2 StSlWI- S fc fe^»C0!> (3) 
^50 Mo 



(4) 



- 1 2 6 8 1 4 



(rll) 2 - (r 12) 2 = (r2 
±|B(3) 5ta>5>, s/ hsl*5<tr5s2^>*Iwli:w2^#tH 
^jaft'J^*Bwi^^< *f9IIBPBa^Ai=A2i^K 

[0 0 18] s> bsl, s2<D'*/l'Xl$i£&fco 

BHnffiftAltJiov^o^te^'W 
= [ (01 ) /2) C (rll) 2 
= [ (rll) 2 - (rl2) 2 ] /2 
ffl P B «A2 {^OV^TC * 
= [ (0 2 ) /2) C (r21) 2 
- [ (r21) 2 - (r22) 2 ) /2 
Lf;^ot(3) £*K All =A21 kft*). V^tbt>^/^ 

[0019] (3) «fc <9 * y s> hm<D9Y&jyfe&&#> 

1 . — #*mm<e>* y ? 

rrt\ rll, rl2«g$tl^(Z)T% wl- r 
11- r 12*5** 5 o 

2. r21< r 12<^#&SSfcU ^o^y^hR 

3. (r 11) 2 - (r 12) 2 = ( r 21) 2 - ( r 22) 2 

r22^5ftfeS 0 w2= r21- r22*SjfcS§tL5 0 

4. r 2l£r r Hi: U X r 22& r 12 1 U -LIB 2, 3 3£ 

EJUbi£j:!9. ^r^^ y >y bffia s ife££*i>5o 
[0020] ^c£>J: 5**/*<^#*W^p-* y 

te-T-So K*3R J ?'41, 42, 43, 44^e>a«-Sixfe*^ 

y 3> bR4£3GD^ y y bsl, s2, s3, s4£3£ 
i®i~£ 0 ^y^bsl, s2, s3, s4(7?Sia*J*H Hfcll^ 
^ y >y hU4<D^ y 3> bsll, sl2, sl3, sl4 Sr3iiBL. R 
»fflS^*tlSlLTgaH*tl/feS3te*^51, 52, 53, 54^ 
ftSfrSo H^y 3/ ME4^^y ^ hsl, s2, s3, s4 
<£>*Bf*. #/r^y ^ fR«3<£>ffl^1"£^y 3> bsl,s2, 

s3, s4, <omtm£m 

[0 0 2 1 ] ^LT, S*^51, 52, 53, 54i^W^1® 

^y^hsl, s2, s3, s4COWi4 1 ^^ 9 <£>P^PB«A 
11, A12, A13, A 14^5*9— f^oTV^££>^ y S> 
b 4riiiS*r * 9 *f*-—*r4 it 5 0 %£> 

[0 0 2 2] HJ6^«B 2 



1) 2 - (r22) 2 -(3) 

*TV^§^^i6 0 r.<£>*£\ ^y^hsl, s2<E>f4> 
£01, 02 5 (01 ^02) o Wk:*^ 

^^^^^pb^ah 

- (rl2) 2 ] /0 1 

... (4 ) 

^^^)CD^RB«A21 

- (r22) 2 ] /0 2 

-(5) 

mmmzx^ ^%m^i-^<om\^-m^ } ) ? MS4 

asKttkivrv^o B3£* y 3' b«4 Mtfu ^%%m^ 
5i-54{^f^ tt#^o^t^^Mttli(07 y y 

bsl, s2, s3, s4^fflP£*bT^£ 0 r<Z>^*&7l£ffi2"C 
t>ffli*Lfc(3) *^fe^y hffiwl, w2, W3, w4^gtH 
£*l/T\ ^firtti^S^^BlRBaAll , A12 , A13 , 

A14 ^sf^JS— t^KSSixTV^So fit, mfe^v y b 
20 ^4ti^y v hHtR3 ittS*9-ift«)i-n««^* 

(3) S;<0rll,rl2,"*^H^y S> b « 4 ^fflME L V ^ 

H^y ^ bS4©#^o^y ^ b{-*t/si"5^y 
3/ bR^3Jtco^y y bco{&B£*Pffli-£o 

[0 0 2 3] 11^121:11 H^y y b«4je:R(t 
bthfc* U^Fs 11— s 14(©W*:9!:feT*5 9 , *V 
s 11- s 14^#^*t^5^y ybR«3^y s'b© 

30 ^^fli2^^V^rt>S*^51-54^m^l/-</l- 
^SP— ftU 0 6(a) COgfS^BOv^^jK^H 7 

(a) <DCk c<D£5ftm£^<nfttiiS&&&±£fr 

[0 0 2 4] Jfe*5. ±iiS<0*»W^*JS?Kfi"C^(3) * 
ML^y^bM^t^\ «h73>^-Ct>£ 
. xyn- ^(incremental encoder) ^St" 

H*<^tr^ b KSrtu^sr^y y b • 

— ^ (absoluteencoder)(^ 1 f>ilffl't"5wtdS"e#So M 

ffi&mi. mmmm2^i^ *v ? bR«3 tm^^v 
^ vm4 t<D{±mmmK s^y^^^y ^ bRt£3, 



H^^y^b«4, S:«cDHil-egae^tbrv>^^. s 
3te«flj;*)H^y 3> b«4. ^y ^ bR«3. &%m<d 

%k 50 >IT?SBH * tt-c t» J: V \ 



(5) 



8 



[0 0 2 5] 

y ^ h R«afei5^H^^ y ^ hm^m^ti±^ 

y 5/ b£rigiS£-£T, y v Y (DW^t^^M^^ 
*3^T. H3£*y s> b«<D*y ^ b^W&4^^<9^ 

fee ^ y s> b<z>ffi£T*a>£>*Ubfcta— ^ y 

(rll) 2 - (rl2) 2 = (r21) 2 - ( r 22) 

[0 0 2 7] rcDJIS*, 5 ^ffiffil*9 ^^JB 

b ©iffiSrfB*. • ^ojEtt^SEW LTK5£*T S - t a s "t?£ 

[mi] ro*w^nife?&ffii^^y ^ MRtf^sia-c 



#BB5p9- 1 2 6 8 1 4 



* [0 2] r<E>3B9i<^ 

[0 3] ^^w^^ss^ffia^w^Sr^i-^ia-efe 
[04] $ y ji>-=i— 

T?$> So 

[05] 04co^ y iy bSo^pffiig-efeSo 

[06] >7 FiiasfflMf^tPJii^fe 

S 0 

10 [0 7] ^y 5/ b«(^J:Sm^fI-^«r^i"lftWia w CS> 

So 

[0 8] — ^ y 3^^=j— y<Z>«jB£S:^-t"^ 

1 ^ yiyp-^ 

2 mte^-y^b 

3 ^y^bR« 

o 

20 0 ^ y hOWft 

41, - 

51, •■- S**^- 

ai, - ^y^ b£>nn®w 

rll, -■■ *y y b<Z)*MM<£>¥4£ 

r 12, -•■ *y ^ b^rtflao^s 

si, — ^y b 

tl, ••• b^^^ 

wi, •■• yhc 



[01] 



[0 2] 



[03] 





[04] 



3 : *U!»MR 
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